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Динамический алгоритм стабилизации 
походки шагающей машины” 


Предлагается методика построения алгоритмов стабилизации параметров походки шагающей машины с 
цикловыми движителями. Структура и параметры алгоритмов управления определяются на основе 
решения обратных задач динамики привода шагающей машины. Задача синтеза сводится к 
определению законов формирования задающих воздействий исполнительных двигателей. Алгоритм 
стабилизации представлен структурной схемой. 


Шагающая машина «Восьминог», разработанная в ВолТУ, предназначена для 
движения по грунтам с низкой несущей способностью [1]. Ходовая система машины 
выполнена в виде двух конструктивно связанных шагающих модулей правого и левого 
бортов. На каждом шагающем модуле расположены две пары, работающих в про- 
тивофазе, четырёхзвенных механизмов шагания. Привод каждой пары механизмов, 
образующих шагающий движитель, осуществляется с помощью жесткой кинематической 
связи от одного электродвигателя. Вследствие этого следовая дорожка машины строго 
фиксирована, а походка является регулярной и неуправляемой. В связи с этим во время 
движения машины у оператора отсутствует возможность выбора мест постановки 
опорных стоп, что сужает её эксплуатационные характеристики. Однако возможны такие 
ситуации [2], когда необходимо иметь возможность выбора точек постановки опор ма- 
шины на грунт. С целью исключения этого недостатка в шагающую машину 
«Восьминог М2» в состав трансмиссии включается дифференциал, передающий кру- 
тящий момент от двигателя к ведущим кривошипам передних и задних движителей 
одного борта, а также управляемые тормоза (рис. 1). В этом случае появляется возмож- 
ность управлять величинами угловых скоростей передних и задних движителей незави- 
симо друг от друга, а следовательно, изменять параметры походки машины. 

В работе [3] описывается алгоритм управления параметрами походки, в зави- 
симости от информации о координатах границ зон, запрещенных для опоры стопы на 
грунт, расположенных на траектории движения каждого из бортов машины. Опреде- 
ляется требуемая величина горизонтального смещения д, =х, (1) -х(Г) опорных стоп 


передних и задних механизмов шагания на относительной траектории. Во время движе- 
ния машины величину горизонтального смещения 0) необходимо сохранять постоянной. 


Так как относительная скорость опорной стопы существенным образом зависит от 
её положения на траектории, то для предотвращения необратимых потерь на деформацию 
грунта, необходимо управлять угловыми скоростями ведущих кривошипов механизмов 
шагания для выравнивания этих скоростей. 


* Работа выполнена при поддержке программы «Развитие научного потенциала высшей школы 
(2006-2008 гг.)». 
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Рисунок 1 — Кинематическая схема шагающей машины «Восьминог М 2». 
1 - дифференциал; 2 — управляемые тормоза 


Методика построения алгоритмов стабилизации основана на решении обратных 
задач динамики привода шагающих движителей [4]. В качестве двигателя используется 
асинхронный электродвигатель, управляемый изменением частоты питающего напряже- 
ния. В этом случае задача сводится к определению законов формирования задающих 
воздействий для исполнительного электродвигателя. 

Уравнения динамики привода механизмов шагания записывается в виде 


О Г 9%“ М 
ом, К=Ь2 (1) 

р) 0Ф, 2 
где Л, (Ф,), Л (Ф,) - моменты инерции механизмов шагания, приведенные к валу 
бортового редуктора и их производные по углу поворота; ф,.,ф,.,ф, — углы поворота 


кривошипов механизмов шагания, их угловые скорости и ускорения; Л, (^ А ‚) — сила 


тяги, приложенная к опорной точке механизма шагания; А,,Д, — деформация и скорость 
деформации грунта под опорой; М, — управляющие тормозные моменты; М- момент 
электродвигателя; Г (Ф, ) — зависимость перемещения опорной точки механизма шагания 


от угла поворота кривошипа (характеристика конкретного механизма). 
Для четырёхзвенного механизма шагания, используемого в шагающей машине 


«Восьминог М2», функция /(ф,) имеет вид 
Л(Ф,)=х, =-0,28ф; +0,345ф; —1135ф, +1,115. (2) 
Линеаризованная динамическая характеристика асинхронного электродвигателя 
ой+м в [1-1 (3) 
у 


где т — электромагнитная постоянная времени двигателя; а — постоянная, определяемая 
по каталогу асинхронных двигателей; и — число пар полюсов; у — частота переменного 
тока, питающего обмотку стартера. 

Согласно постановке задачи, алгоритм должен обеспечивать перемещение опорной 
точки одного из находящихся в фазе опоры механизмов шагания с постоянной заданной 


относительной скоростью Г. При отклонении скорости И, (1) от заданной, уравнение, 


определяющее процесс установления назначенной скорости, записывается в виде 
и (1) +АИ (#)=ЕГ„, (4) 


«Штучний 1нтелект» 32008 429 


_6ж. Жога В.В., Гаврилов А.Е. 


где А, = соп5й > 0. 


Так как 
и, (5) 
тая 6 
то в результате подстановки (4) — (6) в (1) находится управляющий момент 
мкА (и -@)- 6 ее и @) 


Ф 


При этом предполагается, что система очувствления формирует информацию о 
величине силы Ё и производит измерение угловой скорости ф. 


Тогда закон изменения угловой скорости описывается уравнением 


[ 


.. . @Ф КТ 
Ф+-Ф|] о Ф- К |= > (8) 
к. Я 


которое следует из (1) с учётом (6). В выражениях (7) через Л, , Г — обозначены 


частные производные по углу поворота от зависимости (2) перемещения опорной 
точки механизма шагания. Решение этого уравнения показывает, что закон измене- 


НИЯ угловой скорости подчиняется уравнению 
’, (7, те И) РЕ. 
> 


Л Л 


где И, =@„Л, (Фи) — начальное значение скорости опорной точки. 


(9) 


ф=@ = 


На рис. 2 показан процесс установления требуемого закона изменения угловой 
скорости « при различных значениях начального отклонения от программного. Из вида 


решения (9) следует, что по угловой скорости движение асимптотически устойчиво в 
целом. 
Из уравнения (9) с учётом (5) находим 


Г, -Р 4 
(9) = Г (фи) +7 и-——@-е а (10) 


1 


где Г (Фи) — значение функции в начальный момент времени. 


Движение по углу поворота механизма — устойчивое. 

Реализованный закон изменения угловой скорости является задающим воз- 
действием для формирования угловой скорости выходного звена другого механизма 
шагания. Для этого механизма требуется найти законы формирования управляющего 
момента М, , при котором отклонения 6 =х, (1) —х,({) в переходном процессе изме- 


няются в соответствии с решением дифференциального уравнения 
6+ Кб + Кд = №20, › (11) 


где Ари А. — положительные постоянные. 
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0.5 1 1.5 2 2.5 3 С 


Рисунок 2 — Законы установления угловой скорости (А! = 10). 
1 — программный закон @,„, = 2,597 с';2-@,=0;3-@, =3,0с' 


При этом скорость опорной точки этого механизма шагания Г, стремится к заданной 


программной Г,,. 


Определив из (11) $, (1) подстановкой выражения для д с использованием (5), (6) 


и учитывая (1), выражение для управляющего момента получается в виде 


а ОО 
ль (12) 


[фл +6 (и, - ФФ [и - Л, 2, 


Уравнение, описывающее установление заданных кинематических параметров 
движения входного вала этого механизма шагания, в этом случае имеет вид 
Ш 


.. . р .2 Г [ Ра = Г. 
9. +Ф, | 2 Ф, +ЁЕ., | = (Е. +Ко 0 + 
2 2 У 2 12 12 02 —_ К . 
АА» . Кат ие в 1(Ф,‚)- 7 Ф) 
в Ло, 
где Г(Ф„)= /(Фи)+ 6. 


Синтезированный алгоритм содержит три параметра А! ,А,, К» ‚ которые определяют 


(13) 


2 


характер установления требуемых законов движения, и их необходимо назначать из 
условия реализуемости этих движений с учетом динамики приводов управляемых 
тормозов. На рис. 3, 4 представлены графики переходных процессов установления тре- 
буемых законов изменения угловых скоростей с1(й) и @22(1) (рис. 3), значений заданного 
смещения до и скорости опорных точек Г„,. Графики получены для следующих условий 
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программного движения: Г», = 0,2 м/с, до = 0,18 м, фол = 2,545 (х1(0) = 0); фо= 3,5. В на- 
чальный момент времени скорости опорных точек равны нулю, а значение начального 
смещения опорных точек механизмов шагания отличается от требуемого на 30 %. 


©, с 
.. 

1.5 

1 
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Рисунок 3 — Процесс установления программных законов изменения угловых 
скоростей @1([ и @22(1) 
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Рисунок 4— Характер переходных процессов при установлении программной 
скорости движения: 1, 2-— скорости опорных точек механизмов шагания; 
3— требуемой величины горизонтального смещения опорных стоп 


Как видно, установление постоянной скорости движения и заданной величины 
смещения Достигается за время, равное примерно 0,3 с. В действительности, в силу 
инерционности исполнительных приводов фактическое движение будет отличаться 
от задаваемого. 
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Для определения частоты управляющего напряжения по значениям @& и @, 
= 
находится угловая скорость входного вала дифференциала @ = т (2 +@,), которая 


подставляется в (2) и из полученного равенства, при заданном моменте электродви- 
гателя, определяется управляющая частота. 
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В.В. Жога, А.Е. Гаврилов 

Динам!чний алгоритм стабйлзацй ходи крокуючо! машини 

Пропонуеться методика побудови алгоритмв стабллзацй параметрав ходи крокуючо! машини 3 цикловими 
рушиями. Структура 1 параметри алгоритм керування визначаються на основ! розв’язання зворотних задач 
динамжки приводу крокуючо! машини. Задача синтезу зводиться до визначення закошв формування 
задавальних вплив!в виконавчих двигунв. Алгоритм стабуйзаци представлено структурною схемою. 


Г.Г. Ейоза, А.Е. СаугИоу 

Оупаписа! А]оогИ Вт оГ Моуше Ба У/аКто Масвше 

А пе\у тефо4 оЁ такше ап аеогИт ю а Ште Фе тоушз дайа оЁ фе тасбше уу сусПс ргореШпе 
асеп{$ 15 ргеземе4. Тве сопёго| згасаге ап даа оЁ Фе а[зогИ плз аге 4ейпе4 оп е Баз1$ оР дот Фе 
шуегзе Чупапис $ипл$ оЁ Фе шоуше таснше 4пуе. ТВе уп ез15 апп гедисез 0 Фе 1а\уз дейш@оп оЁ Фе 
ехесийуе епошез зе те шЙчепсез. ТЬ1$ заб Шханоп а1>огит 1$ ргезете шт 1е зтасага| зсВетез. 


Статья поступила в редакцию 10.07.2008. 
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